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Abstract of JP 4237637 (A) 
PURPOSE:To form a system capable of controlling 
a vehicle by estimating the ever changing motion 
information of a vehicle in operation necessary for 
various kinds of vehicle motion control at real time 
from the measured value of acceleration sensors. 
CONSTITUTION:The motion of a vehicle is 
estimated on the basis of the information from 
acceleration detecting means for detecting the 
longitudinal, lateral and vertical acceleration of a 
vehicle. The translational acceleration, translational 
speed, angular acceleration around an optional 
coordinate axis, angular velocity, and the like at an 
instrumentation point to an optional coordinate axis, 
the center-of-gravity point of the vehicle and in an 
optional position on the vehicle are estimated to 
enable the high accuracy and high function of a 
vehicle control system. 
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(2) 

1 

iRlcDtd. £*®filiv ±TcD$|[i©'5"^ 2-30Ditti(ciBMS 
n. -€-®5*.®->!7[::li2M®iinjiS'^ta¥S$>'5v>t± 

2tt®JlDSffi^|W|^lC«tm-C$5#*fiMliiS©SDS^^ ^ 
5 ] 1 fB«c©»McD^»l«SSM(c*Vi 

•5-;^oiftt±fctt, •k>-y-*i&a-rsiftitofifc&iRii:ttit 

•3, MIB2M®SDji*«im^StCjC^L.T'bSe.tC«ltHtt 
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2 

mim^\ mimi%m<n^m<^m%m.%-)5mz^\^ 

T, *5:)&lR]fig^®;^Jlia«&te®2^®:ftjg*4fflt,i 

[»*:^9] *il®«|)jtt^&l^tB-r-S)^til^a;0>e.® 
■tfStS-:?V^T*S®WW2rT«.*W®«fflie>XT-A(C 

fev^T. M?a*5g®*(r«. fc*, ±T®^:*ini®*a« 

^ffi^Si:. *fi®liFKi£S&^m-r^*$ft3Smm^ 
ai:. ■9-X'<>v'3>'®^fi:;0^C*iS^i^a-r5*iS^ 

^'^msmmm-^md^^ma^ ®«^ffi'if s®*-:?v^t* 

[«f*«10] «*JH9|B«®*M®M«>'7,^Afc:fe 

^^S*^tt&^tS:!|#iii-ri.*M®Mli>'X5"A<. 

1] »*:«9tBilc®*i^®$!lffll->X5^Afc*5 
V^T. fuBBJDiS^^£il^aiC<fcoT#e)tlSai3iJ5;0^6 

;5*tBOiiff:^i6l^o3tS*^e.*:S®x U -y 

A. 

[H^j^i 2] WjRJBgiB*®*^®^!^;^^^^^* 
ViT. mrnBiinj^S^tfi^g t i o Tf# s ns Jjiijia;^^ 

e.#sn«.*tt®aff*iRi'N®s«*> 6*w®ign(iigfi 

RlX;^[SlS««-r5 i ^:-r5*p®ft(i«->Xx 
m^m \ 3] B*JR9tB«®*j^®$!lffl->X5"AC:fe 

v^T, ^*3£8e)Snit^s«T®*w®MS, 

;<>h, ttttSI«®7'-^'^tB'»-r^lB1i^g:SIIA;5: 
:i t ^#Sifr^»W®SiJ«>'XT-Ao 
[fgW®^iWI:^iei^] 

•«®«i!)if ffi({4M, ^m^. wcM^.. mm 
S> hJi/i?) **s±t^fELfc«Sc«®iinjiS-fe 
>-!J-®»j3e«35i^iii^-r^*w®3i«i«5ess. ^®* 

01®ri:<*#:±fcxy zttS:®D, ;i®*Sa 

'L>;SM D ®«»is 3 'A'KM^nmmmmhmk^u. 

(1) x«i;&|6]Mii)S«r-m««i, (2) ymi^wmmi 
(3) ztt;&[RjMjiai!r-±T», (4) xUii 
Olllte^«i-n-U>5^. (5) yttMD[Slte^fj-tf>7 
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(3) 

3 

>hn-;k 4*|IKl!i, 4*ilSlj!6, ^^(ct±, t^'t^w' 

2-3 0 7 8 O-^Tli, »ilM^lRllC2fi©JnSft-fe 

*«ffl-rs 'y-xj-AU Emim-^ nr^r v> 

oXKrtt, ±i^®6gfiS®aifj*s|Rlli#ic]BBS;5nTjE 5<? 
•fe >it g *;55»3S««ifl S LT -5 *P± tc nx 

•fe>u-©tfttti:*[Ri»*H©iii«t*fc(» 

it&m^x-&^mn\zii'uniB.\^xhtofzJ^, z.<d 

lElitfcffiS-r ^ t <fc 0 iiS«?S:*rafll«)i)t 

-r e <nmm.\zmr5\^^x-^m<i:>mi\-^mm- 

^%n<DmMimMmmz^\-^x. m%^m^^'mwm% 
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4 

e> ©it« a T#i^©««) sm^-r s *m©^I!)«i 
(S5i-©inajs*^tEiL-, ^n^m-^ntdsmm^<^^%\z 

mm^-^imit^m^^mi-^ ^ ©^it fgics^t^r^s© 

^, -hT©#^lBl©iD3Sft«^{fl^ai:. *fft©lil 

©s&die.*Ksi^mT^*««^m^g;i:, *»©«eA 

©«^aif «®»-:iViT*M©«« *ff 5 
[fpffl] *i^® A'^-h®ffi«©f4BJrft 0 #(tfc 6 «© 

(sm. A£*, ±T) <nti. mmmUs mmu. r 
n^mm^ {\Lv^yf. u-^yf. -a-^ym © 

©tiaia®ti^-t5„ sfc, *«!M-fe>'9-^ie^^-fe>-9- 

i:ffi® *WS«i tcMt. -k J; 0 « 6 ti;^c7' - ^ 
t CNf ®»#:®^l!iSiEfllC|ES-r5 ^1 filfi 

*PSt*f§HjSagfflL^c«^©Slii«S0ffi 
tcSo'^ifil^-r-So Hits, 3f:*Jg0i|©SS©«^Sr^ 
tWCib^. X>J»7 1 i^mkl 2 a 

t. £M*fi 7 2 b 1^m^ 7 2 c £ft« 7 2 d 
t< &Si:S iftM-t >it 73a, 73b. 73c, 73d 

^fS©:/k-^7 4 a, 7 4b, 7 4 c, 7 4 d 
X5^T'J>i^«l«7 5t, =&«-y-X'^>va>»M7 6 
a,76b,76c,76dt> n>ha— JVx7 7 7 

X7^7'U>i^7 8i, 7i'-t;P'<^;l/7 9 i, 

-4^-^y;i'8 0 ifeAttW^iBs It. XD-;/ 

SI58 2t. y^k-^?*JlMfl»8 3 S-yv-a^MW 
gB8 4i:, 6 gS^ai!iir>-y-8 5 nyVxi-)\^3. 

h 8 6 tTH^S^nTVi^.o *«iji-tr>-tJ-7 3 a, 
73b, 73c, 73d «, =&«ii:^ttC|ilte-r5«^W#* 

V »(ilHIte^lJS^cMJSbfc:/'?;^x5lJsm;^•r^o 
c©/i;pxMiBStfS!i-rs c t tct o*«i©#imiK«« 

C:fett-5*(ili^*t«^ffl-r^^„ *tgi©>^U~=^-7 4 a, 
74b.74c.74dli, ^tfttcMft^'j^abfc^S 
WfC. f^»B#©:/I/-4^7-1'>jE©-fe>-y-t)*fc«IAT 
Vi^. U-X'<>v'3>««7 6 a«, y>A-« (0^ 

-B-T) I'X hn-i?-b>-y-6 1 a (0^*-r) S::Sr«L 
T*D. *ffB*fc=&*l1)-X^>>'3>«ll«©Xhn-i7 

aa^m-c^^). •fifi©-y-x'^>^^3 >««7 e b, 7 e 

c, 7 6 dfel^^CX hn— i'-fe>-S-?£=a«|bTl>S, 
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\z. mnumw^s 1 xn>y h;PMWgl5 8 2(?>t&f^rt 

U>^««7 5. X>>?>7 1, #«lf>^l/-^7 4$M 

\zm'f^mm%i(o'^mm^^'Lx\^>^. latc^^n 

tCit3?-r-2>]K#X^- 7-9 ±(C#X7" - 2 «T:3Ba 
it5~6l^yM> (0^:b\^^mm^^^o\Zf^-DX\^^ 30 

3Pj$Sir>-y 1-2, 3-4, s-^ecD^ 
ffi;^[pltt::n<:o^(hVi5i?T»;^<, I~2^y1ft, 3 

'-4^ztt, 5-6^x|fi. ^^V^^5^^. (ft) 

?*:tc. 114 Jq«S-lr>it(DWT^htcM"r^%PJ 

(xW^fRi) tc^lytt*rRlc^Stlii«^«^fflT§'t:>-y-l 

5 ~ 1 6 z tt^r ^cDjP3$g^^^m-r -^-fe >1M 1 1 40 
Itmm-^n. St#XT— 18 (ytt^fn]) tCl^x*:^ 

}^(Dm'mm^mmT^'^>^i 3-1 4;^?tEg$nTi^^* 

Ri =Rs + ai R2=Rs + as 

R4 = Rs + a4 R5=Rs + a5 

Vi =Vs +0)3 X ai V2 =Vs ■ 
V4 = Vs + cos X a4 Vs = Vs - 
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6 

ztt. x«:5fR]ap^s«^mo'k>it^saBr^;^<i:<^M 

rK^T#2at)*'5o 0 5tl04fC:felt'5xfH± 

cottliS^^r>i^*l 1-1 2, 1 5-1 6^. |il^lc2M 

xrcm-^x&^o mx\t. sm^a^mmmm^yii-f)^ 
m^i^^<Dm'^t^'tt:^i^^$>^<D^tmo^xhr^\^^o ^Tc. 

«ffi.eg;^i:x, Y, zmmm^m. ^(DmmmnzMm 

#e>n^o ^x. ±m(D6m(Dmmm±>^<Dmmmf)> 

^^M(Dmw]^M^T^:^mz^i^^x^^^. z.z.xm 

m nmx^^LU^^^o r^^:^. ±>^u-rr^h\z 
^\^^x\ms. 04. 05, ^vift-^-ncosft^^a-^ii: 
om^. r^EEo:>m^xh:^m^f3immt;i^^(Dx\ m 
scDm-^^Mizm^xmrn-r^c mw\z. m6\t:i::x 
m^>^n^ 4mm<Dsm^^^vx^>^o s-x 
1 X2. :^3.\t^(Dm^m±\zMm&±>^i-e^i^^ 
V. }S.s^mjs.izm^. ^y-^tmz m-Dx^mt^^ 
iz) m<mmmm^x$>^. mmiz. G-xy z«*i^ 
(Dm^\^G^mM.^z^t>. mmm<DMmts-Ki x 
3 t^t)^u^ymwi&m^x$)^o -^j. o-xyzu 
^m\zMvm±v. zm(DM.:fj\^^mmmti:^\^\zm^ 
mmtr3i^m±mm^x^^o ^^tcE-xiXzX3« 
mmt^otm-xm:^\^\ts - xi X2 k^axsg-k 
yztm-(D m^xmmmm^6^\mrcrM^mm& 

^ o \zmitmm^o- xYzti^ ^^tzMmmm^ s-x 

1 X2 X3 coM;^sxr;^>i?- 1 — 6 co-e^MSi — Se 

ODSM^^ h;i/^Rs. Ri~R6. I^tc. S/^^^Si-S 

[Sci] 

Ra = Rs + aa 
R6 = Rs+ ae 

[iS:2] 

a)sXa2 V3=Vs + a)sXa3 
cosXas V6=Vs + cosXa6 
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(5) 
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8 



* Ae =As +Aa)s Xae+COsXCcOsXae) 
[ic2] . 

As.tA,. AstA.^Mizhxm^mmKt'A^^n 



^W^-r^t. .^S. Si-SeTCDjP^ffiAs. Ai~A 

[^3] Ai =As +ACOS X ai +COS x(cos X ai) 
Az =As +Aa)s X a? +cos X (cos X a?) 
As =As H-Acos X as + cos X (cos X as) 
Ai =As +Acos X a4 H-cos X(cos X a^) 
As =As H-Acos X as +cos X (cos X as) 

Ai — A2 =Aa>s x(ai — a2)+ Ccos X (cos X ai ) — cos X (cos X aa)] 
As — A4 =Acos X (as — a4)+ Ccos X (cos x as) — cos X (cos X ad)] 
A5 — Ae ^Acos X ( as — as) + [cos x (cos Xas) — cosX(cosXa6)] 
Alia?. A2i:ai. A3<ha4. A4dia3. As ^iy^\< t'A^^l^^o 

a? X Ai - a I X A2 =- As X (ai - aa) + Ca? X (Acos x ai ) - ai x (Acos X 

aa)) + Ca2 X COS X (cos X ai ) — ai X COS X (cos X ag)] 
a4 xAs - as XA4=-As x(a3 - a4)+ Ca^ x(Acos x as) - as x (Acos x 

a4)) + Ca4 x COS x(cos x as) — as Xcos X (cos X ad)] 
ae XAs — as X Ae =- As X (as - ae) + Cae X (Acos X as) — as X (Acos x 

as)] + [as x cos X (cos X as) - as X cos X (cos X ae)] 
0Sl^S -XI X2 X3 05#tt:^fR]C7^¥&^^ h ^* (a5-a6)= (hi+hg) es. 

;i/^ei (1,0.0), 62(0.1,0). (0,0,1) ttn\t. & ±(Dm^^t-^i7 h)vmM(D^A^^m^^x 

[^6] (ai-a2)= (I1 + I2) ei [^5] ^^M'r^t'A^^^f^r)AL-:>c 

(a3-a4)= (di+da) * 

Ai — A^ = ( 1 1 + 1 2 ) [Acos X ci — {(cos • ci )cos — cos^ c I }] 
As - Ad =(di + d2) [Acos X 62 - {(cos • 62) cos - cos^ 62 }] 

As — Ae =(h] +112) [AcOs X es — {(cOs • 63.) COS — COs^ 6 3 }] 

[^8] eiX(l2Ai+ liA2) = (li+ l2)eiXAs -^X Y Z:ft> Sl^feSTf^^dt, 

62 X(d2 Ai +di A2) = (di +d2)e2 XAs 

63 X(h2 Ai +hi A2) = (hi +h2)e3 XAs 30 

UL. B^'imm^mTo hz.^x. j^s,--se\z^ 

Ai =Ai 1 6 1 + Ai 2 6 2 + Ai 3. 6 3 A? =A2 1 6 1 +A2 2 6 2 + A2 3 6 3 

As =A3.i e 1 +A3 2 e 2 + A3.3 e 3 A4 =A4 1 e 1 +A4 2 e 2 + Ad 3. e 3 
As =A5 1 e 1 + As 2 e 2 H- As 3 e 3 Ae =Ae 1 e 1 +Ab 2 e 2 + As 3. e s 



M^S — xi X2 xs 

[ic9] 



Z.Z.X\ A12. A22. A3 3. A43. A5]> A6iiO"^6f@cr)SPiS^ 

±>'^\z^-oxmm^n^&^x$>^o ^rc. as. aco 
^frrj:^^\z^mhxmf^rt'A^mu< ht^^o 

[^10] As = Asi ei + AS2. 62. + AS3. 63. 

Acos =Acosi e 1 +Acos2 62 H-Acoss es 
%^X. 



1. 



40 



[IS: 10] cfco. s.'^Tc^^feita^iJt^^ h;pAs. iSc 
unMmm^^Y)Vko>^(D^^mt.. Ai2(hA22^D 

As2, Acos2> A33 chAds J: DAs3 > Acoss, St^Asi^AeiJ: 

DAsi, Acosi;^^*^n-€^n#^n. :k^x^pL^n^o 
[Sci 1] 



(l,+d,> 
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[iCl 2] 



(6) 
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10 



[^1 2] 7!E3:^BP?i^^S5j^Acosi. Acos?, Acoss^^ 

m^^uiit^^o ^z.r\ m4\z7jkr:^t<. m^l^g^ 

Ac =Asi — (Act)R2 zs — Aa>s3 ys) — 

— cos^ xs] 

Ag =As2 — (Acoss xs — Acosi Zs) — 

— ios^ ys] 

Ag =As3 — (Acosi ys — Acos? Xs) — 

— Ct)S^ zs] 

ch^^o h;i/Vc = (VG ,V 

G ,Vg ) t^, 

[18:16] &||^J'T-^2:^tci0^is6^;i^;^^^7?^^o 

(DzmmrxDrnWi iB--f>if) ^mmr^m^. 

MDcoaSj (n-U>^) ^yfft^J:)<7)a»j (tf ^:7^> 40 
a>s2 > AcossUMWjM^^S - iQi X2 xs TcD^^^i^Tab 

MitBtliiSAsi. Asz> A3 3.. Ag > Ag . Ag 
»lhffiffiO-XYZT^«$n&^^h;PAs. AcCOSfe 
;5Pmic*5CtS51i!iffiS^S - XI X2 X3 (D#«;&fRj 



[&1 3] Rs-Rc + as 
mi 4] Vs=Vc+a)sXas 

[^15] As=Ac+AcosXas+a;sX(a;sXas) 

iHT Ac ti«.i:\«GTCDMiiSiia*^^ h)l^$>^o 
mm(Dmm&m^S-iLi x? X3 C0i:^C0Sl.ii:|n|il 

\z. 

mid] ^m^L\^G^mj^L^^mmmm^G-Ky 

z (D^miZ^nfS.^^ (S-xiX2X3^fe¥ff) \z^ 
MhT^^X. as= (xs, ys, zs) ]Si:lXAG = (A 
G , Ag , Ag ) i:MWt^. ^^^\ZMVX'A^^% 

mi 6] 

C(ct>si Xs +C0S2 ys +Ci>S3. Zs)C0si 

C(a)si xs +C0S2 ys +ct)s3 zs)a)s2 

C(Ct)si Xs H-COsz ys +0)33 Zs)(0S3 

^r:i^lZlt. S - XI X2 xaJttf G- X y z IZMl^T^ 
*5 V> T«;5fnl^^# L < JS.^^t O E 

-XiX2X3^#^. ;in^TC0?I»{C^D5i<^fcfi^ 

^K?:);^^^^^^^^^^^^ :klz. E-XiX2X3(ho-x 

[iTT*^o ms\t. z.(Dm^\zM^^miE^fforciib 

<D^mmizmr^h(Dx\ -mz:t^^-nMmtw^i 
nx^^^o miz^^n^z:t<. xzMtzm(Dts,TM 

ON txm(Df3i'tA^4>. ONtX^^(Df3:^M^^t 
-rnU. E-Xi X2X3^:0>e»O-XYZ^-\0!)^g|fT 

m\rA<D^^\z^x^n^o 
mi 7] 
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fib 

Qii = c o 
Qi2 = — c 
Qi3 = s i 
Q21 = s i 
Q22 =— s 
□23=— s 
Q3 1 = s i 
Q32 =— s 



s<i>cos7/j — COS0S in<&s i n-^ 
os^s int/) — COS0S int^cos<i) 

n 6 s 1 nij) 

n0cosT/) + cos0cos<i)s int/> 

i n ^ c o s <f) 
n ^ s i nt/? 
i n ^ c o s 1/? 



* Q33 = c o s ^ 
T&O, it^ailPjiS^^ hjl/AG =(Aox, AoY, 
Aoz)^ :^JPjSS^^ h;l/Acoo = (Acoox, Acooy, Acooz) 

mi 8] 



ci]i£= — UfS i n ip + w^s.i n o s ^ 



« * = Cd 0 /dt) , w * = (d /dt) 

^ [&19a] 



[^1 9 b] 



C 0 ?tO) 

«*= (wxis±n^i + <oi5(CQs^) / sin 
«*=Wk*— w*c o s 0 

(fl = 0) 



COxi=(i)si> (x)x2=(x)s2> coxa. = C0S3"??^ 

[gel 9 a] . 



[ic2 0] 



I 



40 



z.z.x\ NGUhJV^. i.umm^o:)^mo:>f^mmm. 
(istt^->^ > h I . m^mm i ( i ^ j ) ) t 

Nc =(I Acosi+I Acos2+I 

+ 1 cos 3.) — cos 3. ( I COsi+I C0S2+I COS 3)] 
Nc =(I Acosi+I Acos2+I Acos3)+ [cossCl cosi+I 

+ 1 COss) — COsid COsi+I C0S2+I COS 3)] 

Nc =(I Acosi+I Acos2 .+ I Acoss.)+ Ccosi(I cosi+I 

+ 1 COrs) — COszd COsi + I C0S2+I COss)] 



cos = (cosi , C0S2, cos3.)> RZSMMMS.^^ h;l/Acos = 
(Acosi ,Acos2,Acos3)^fflV^T. h)V^^^ h)VNc<D^ 



m2 1] 

Acos3)+ Ccosz(I 



COsi + I C0S2 



C0S2 



C0S2 
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13 

= (Ac . Ac , Ac ) t*M®M*MSfflV^T, ^< 

[IS:2 2] Fc =MAc 
Fc =MAc 
Fc =MAc 



14 



-XI X2 x3 ©xitt£*P9tt^:&|Bi. X2tt^ffi:^ini, 

«> 

[ic2 3] 



Me t:&i<LM^:^m^bi^$>^^^. COS 0 = 1. CO 
st/)=l. sin(9 = £?. s i n t/> ^ t^* ^JEIHT^. ^ 

[&24] Qii = c o s (f)-t|)(s i n0) 
Qi2 = 0 
Qis = e • t|> 

Q2i^sin<i) + t/) (c o s <!)) 
Q22^— (s in<i)) 7/)+ (c o s <t)) 
Q23^—0 c o s <f> 
Qs i =^ • t 

Q32=-d 
Q3 3 = 1 

^ ^ D n > tf - P^gE(Dy 7 h "^xy ^ LT^JIT^ 

fc5e)(7>n!y:7T 6 1 , RrJ^^v-f 5?nn>t:rL-^2 8tc 
.^DSt^^n-So ^-f ^7nrt>tfrL-^2 8ti. Ifle 
b<^S«ifce(^)CPU2 8 a. I/02 8b. ROM2 
8 c, RAM2SdRn^<Dm<DmmhSlxm^^n 



01 O;0^^ 1 4tC^f ct^^C. S*a(rjlteX^7- hB*<7) 
X > >^ >^ - ;&t:t > ^ /^.c -3 t^SlTT^ ^ n rr > tf - 

AM 2 s dizt^'m^n^y^-^n—^oiz^^-^n^. 

Sir >ij- 1 - 6 \^mmntitmmB<D^^^\^^^o 
spa«ir 1 ~ 6 ^m^mm^ 2 1 ~ 2 e ^jg 

ntcL^^o ^(Dt.^. gi~g6^^AD^tt:gg2 7, I 
/O 2 8 b^r^M^TV-r $^Pn>t:ii.-5^p^lcA:^$ 
n, ROM 2 8 c ^nTVi^^>'1f^Sfii 
hi. h2. li. I2. di. d2 <h*i::CPU2 8 aJcn 

^ ^m\zm^mmi}mm (gsi, g32, gss) ^^s^^ 

G , gc , ^ G ) ht^^o Z.(Dt^. 

miy^^Mmmmmo-xYzxomf)^ (o, 0, 

bRAM2 8 dtCffl^X hTT^ (X'ry:/2) o 'AlZ 

m(Dmmm^m^u mnmm^2 1-2 eT^^^t^siEb 

50 a^--a8i!3mti^n^o Ctl^t^ AD^^IS 2 7 , 1/ 
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02 8 b^:/M^T'T'l'^Dn>t::i^[^ICAt?$n. 
ROM 2 8 c $ nx ^ ^ >it^^« h i . 

hz, li. I2. di. dz (?:ft^CCPU2 8 a(cn- H 

m^mmmm. (Asi, as2, ass) ikxsmmm, (a 

cosi, Aa>s2, Acoss) ill^)g:||^R AM 2 8 d 

[^2 5] cosi=Qsi+Acosi'At 
C0S2 =Qs2 +Aa)s2 • At 
CDS3 =Qs3 +Acos3 • At 

(A6)si, Acos2, Acoss) t5^0COftiJPjiS(75WTafe 



16 



10 



20 



T^tlT. (X^-zT'S) T#rc::ftJlPiSJ5 (Acosi, A 
C0S2, Acoss) <h^ttc:^|ilco 

m.2 5] mff^JrCPU2 8 alCD- F^nrfflV:^^ 
n^c ROM2 8 c<fcD*PSS^t:\'iSGi:ir>i^-C0 

ess EcM-r-S^St^?-:?^ xs. ys. zs^P-H 
RAM2 8dJ;D (X^^^:^3) (X^^yy^4) 

T#:?titjti)n?ss (Asi, As 2, Ass) msmmm 

(Acosi, Aa>s2, Acoss) ^IjSS (cosi, cos2., eoss) 

(Ag , Ac , Ag ) ^^S&Sm^S^R*^^ 



* — 4> + w < 



A t 
A t 

A t 



= AM2 8 d<;^f§^^«f-X NT-r^ (Xt'-/:/5) o ^ 

[^2 6] Vc =FVc +Ac -At 
Vg =FVg +Ag -At 
Vc =FVc +Ac -At 

^7L-^. (Vg , Vc . Vc ) tt^* ^^fejIJi^Tfe 

0. (fvg , fvg , fvg ) m-^-i 

(Ag , Ag , Ag ) t^^-mcOMSSPS^COeT^^o 
nrcMii3SJ^T^-^l^RAM2 8 d(^Jg^««[CXhT 

$njSi#:::ijcffi:o^Mff$n^ (x^^;/y*6) o ^tc. 

(XT*ty:/2) T?a»!IS^^nfc:t-r^-:ft 19, 0, T/? 
h. (X7^^y:/4) ^^s&fcftjga (cosi, 0)52 , coss) 
^P-Hb. 

[gel 9] J;:Sc5Xm#ypi^^A^^ffLT. 

x\ 6 = 0 t9=^o<Dt^x'\tmw^^mr<siy). mze 

^T. RAM2 8 d JcDP- Fbf:::t-1'^-:fti9. c^. 

(*Sl5HW^fi^KJt;:0.hLTfepI) ;0>=!fcOCDW3iJ^ 

0)82, 0)s3) CDfitJ:*^^ 
[^19 a] IC*0*<mS:^P^vA^^ffbT. 

m2 7] 



5. 



[iS2 8] 



0=9+u# - At 
& = 2 + u , • At 
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18 



c 2) , w\zh^n.^^'e = o^r) e^ohU-:^fz,^'^ 

[Si 9 a] <fcO:t-f^-ft^. 

[JS27] J:D(f)> t/?^ff^ (XT-y >^7 b 1-7 c 

1) o ^LT> a^v-^Tt^^Mitimiig (Ac , Ag , a* 



*c. ) . Mjtj^s (V. , vg , vg ) ^rsmmm (k 

0)51, AC0S2, ACOSs) , (COSl, 0)52, 0)S3) ^ 

18;^:. RAM2 8dJ:Dn-HU 'A^\zm^<1&W:f 
[ic2 9] 



"S2 «2J 



(Xi, X2, X3) \t. S-X1X2X3. :S:iXg 

- X y z hJV(D^^(Dm. (Yi, 

Y2, Y3) t^'^(?)0-XYZffiS^tC^«|^nfc:fiTa& 
fib. (9^0<D^^i:a = 0(7)i:^Tff?fJCC>«iS*^ 

(a^Ocoi:^ : T.'TvZn d 2) 
Dii=cos<f>cos^ — COS0S in(^s Int/? 
Qi2=— cos^s in-t^) — COS0S in;/)COs<^ 

Qi3 = sin^sint/) 

Q2.1 = s in0cosT/) + cos^cos0s inz/? 
□22=— s in<f)s ini/) + cos0cos<i)COs?/) 

Q23 =— s i n ^ c o s <i) 

Qa z = — s in6)cost/) 
□3.3.= c o s 0 

(e = Oc?)i:^ : T.J'V^l d 1) 
Qi 1 = c o s g 
Q12 = — s i n I 
Qi3 = 0 
Q21 = s i n g 
Q2 z = c o s I 

Q23 = 0 

Q31 = 0 
Q3 2 - 0 

Q3 3 = 1 

^LT, O-XYZJ®S^:^>^^fcai^;i^TC0M^i^ItlM 
S (Ao , Ao , Ao ) . MSji^ (Vo , Vo , 
Vo ) mSmm^ (Ao)Di, Ao)o2, Aa)o3.) . 
(a>oi, CO02, coos) &IB^*::*:56, RAM2 8d(Djg^ 

n>tfa.-^«. :^JD3£^ (Acosi, Aa)s2, Acoss) 

(0)3 1, 0)32 , 0)33.) ^Ji^. RAM2 8d<fcD 

C0lttt^-;<>hl > I . I .fitt^^I (= 



(SeitiSS) 

(h;^:5?) 



(Ao)si 
(0)si , 

(Asi, 
(Ao , 
(Vg , 
(N. . 



AO)SZ, A0)S3) 
0)S2, 0)53.) 

AS3.) 

Ao ) 
Vg ) 
Ng ) 



As 2 

Ao 

Vg 



I ) . I (-1 ) , I = (I ) . ^ROM2 
8 CcfcOn- KbT 

xttMDtC«< h;i/;7NG ^*JJe)MffiSS;^^RAM2 8 
dOjg^M^t-ffi^XhTt-^c |sJ«fC. yttlit)tC« 

20 ^^Mfit^*^RAM2 8 d©Jg^M®(Cfi^XhTT 

(Ag , Ag , Ag ) ^RAM2 8dj:D> Sl^SO 
SSM^ROM2 8 c J;f3n- HbT^MiilltJii^iiK 

Fg . Fg . Fc ^*56. #^^W^^^RAM2 8 d 

(X^^;/>^7) (c43^t;5ig^^JS&^DM-rc^tCj; 
0-XYZJffi^*55^e>l,fch;l/>> (No , No , N 
0 ) . * (Ft. , Fo , Fo ) ^^tffb. ^-^rSlff^:* 
J(? ^RAM2 8 dOfiSS:^^cM^X h T UT 1 [UCOtam 
75^^7bT (X5^-/yi) \zm^ (XT'^y:/l 0) o 
(X7=-!y>^l) fi^^ (X5=-5/y^l0) IdS^SWcojSS 

[sv^^Dn>ifri.-^2 8 0ab^ iiMi(;)Si#i^*-r^;i/ 
(KMAt) (7)ra&cfft>n^o (x^^^y 

7^1) (X^-/:/10) ^T^ra^iioTIMlcfT*:? 
J^c^TVi^o IP"^. ^9cD«ffiaSlC«i:!9RAM2 8 d 

(A6)oi, A0)a2, AO)0 3) 

(O)01, 0)02, 0)03.) 

(Ac , Ac , Ac ) 



(Vo , Vo , Vo ) 
(No , No , No ) 
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(ij) : (Fc , Fc , Fc ) 

^«ir >1J- 1 ~ 6 (Dm\z^n<D^^m<Dmims,^m.\!^ 

Mm'r^«eftir>1t4 4. 4 5 (fiU4 5J^4lijftie* 
■r^*i^-il>^t4 6-4 9. ffl#M^#tBLT:^&^M 

<^ftfJffl/^^^-^;^tjft^T^'6o 019 1^017 

1^6. mM'^y^4:A. 4 5, *,g-fe>it4 6-4 9 

fK Bff;fe» : fr, : rK : vKDW^'^^m^^ 

TISSiJT^) cO«mD^/3c. /3 > ^ . ^ . j8 30 

^m'^^^^m\z-o\^xmi.x\^^^. mm^n^n.. - 
mz^n(Dmt^^^m\zmmh. mnmh<\mm(Dm 
n^\^mmN hWj^mmy o)^ti^^:kA(D^^\z 

[SC3 0] 

^ = tan (-^) 
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(Fo , Fo , Fo ) 
c ^fflV^TV =Vc . V =Vc ch'r^:?0\ (Xx^y 
:fl) Xm^TzVo > V3 ^fflViTV =Vo . V = 
Vo tLX. 

oT#^n^o ^^m<Dmmy)M^j^^^\z\t^ 

ms 1] Vt=Vc+cocX n+V 
V t^*i|i^^l:^A*TS«J^^1i-X^>S^3>^^bT 

(A*:^±®«-B!lflc) \zMVMWsr^t^<DmMm 

h)lX&^o Z:ZX. mi SlZTjk^^olZ^X^ 

>i^3>(Dmm^±yyj\^ (zW) co^m^^n^^ 

«^T^ih> h;^rTtC^bT1^-X^>->3>C0^ 

mkZ^o:)^mr^c z.(Dt^. nmiii^(D4m(D^i<Lm 

[S:3 2] (tJSMr) ri = (XT , yi . zt - 

h ) 

Vt - (V t , V t , V t -(dh /dt)) 
(»9*tt) 

Tt = (xt , yi , Zt — h ) 

Vt = (V t , V t , V t -(dh /dt)) 

(^fett) 

Tt = (xt , yi , Zt — h ) 

Vt = (V t , V t , V t -(dh /dt)) 

ri = (xt , yi , Zt — h ) . 

Vt = (V t , V t , V t -(dh /dt)) 

fflL. h . h . h . h nm'^&^0^7s^>zy 

3 >X hn-^(^^ST*D, (dh /dt). (dh /d 

t). (dh /dt). (dh /dt)tl'^co«5)^ffi (MS) X& 

[icsi] JC'f^Ab^StecoMoi^i^^^^ h;i/VT . 

Vt . Vt . Vt <D^^^^^^ ^ L^AO^^U^M 
[SC3 3] 
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Vtii= CVrsfip VttIIj Vtjii) 
Vx«ii=Vq,+ C«s»(zTii — hii) - UBayxri) 

VTyfl=*VGT+[«.>SaXTM'^«fll(iiTll-hiJ] 
Vtit™ (Vxfcfri Vxirr** Vxiir) 

VTiir = VQ,+ CMsiy Tfi.— « aaXXfr] — (dh f p/dt) 

VTr.= (Vx.rl, Vtt.I, V^.rl) 7. 
Vx»rl = Vax+C W SS( 2 Xri-hp|)-C,>sayXrl] 

Vxipi-V«,+ C«fiiyTTi — <«>»»x-ipj — Cdh Pi/dt) 

VTrr= (Vx.rrr Vx^rr, Vr.rr) 

Vx.rr= V«x+Cu»a(z Trr - h *r)- Wsay Trrl 
VxjTP=V<3jr+Cw5»Xrrr — WSlCzTrc — ^rr)) 

[ii:3 4] 

[«C3 3] ©#xy«i*rp]MJijiS^5j^.ht9li&C^^»* 

fiL, 2SISie*(Z)«^ti^lr A =OTS)^o Ell 9 SI, a)s2, coss) ifi^^^Vi^ {7.'T>y^2) o 

Ocfc^fc:^^^ S>^^.'^{c43V^TStJiiSir>it 1 Mffl (xr , yi , zt ) . (xi , yi , 

--6, *eAir>i?-44, 45. **'t:>i^-4 6-4 9C0 zt ) , (xt , yi , zt ) , (xt , yr , 

ilJ^fii=^AD^^S§2 7^ajfi^itTx>?:^;l/ft^tC^ ^ zr ) ^ R O M 2 8 c D , >1J- 4 6 - 4 9 CO 

i^L, V'<^nn>e:i-3^cr)I/0 2 8b^:/M^TA ffl^ffi&lX^(7>aii^ffih . h . h . h mS{Ah 

^^n?^yyr ^ l\Z-m7.hr^tl^ iTsf-y:/ /dt). (dh /dt). (dh /dt). (dh /dt)^;t5/:7 

1) o ^:JlT#i«-fe>'y-coW:tfh .h .h .h r^\^^.^^\z. ^n^*bM.<DmmMM (Vg , V 

\Z--:^^^^XUTi-n^m^\Z.^^m^Ml^^0^mM^'^ G , Vg ) . ((osu C0S2, cosO ^RAM2 8 

XWi^m(6h /dt). (dh /dt). (dh /dt). (dh d J: 0 . JlH:;^fcC P U 2 8 a iCU- H b 

»$tiTv^:^un>lfa--3^trA*$nTl^^^o il[J5i oT#<:ttc?)M5tj^«c7)ffi (Vt , Vt 
J*ir>1^1-'6CDSiJ^tt?^iVN*^y:7T6 li:D*1"fl?rXm Vt ) > (Vt , Vt , Vt ) , (Vt , V 

mio^^^i4(Dt^wtmmo:>mmxmm^ri^ i , vi ) . (Vt , vt , vt ) 
mWi^bj^cDmmsm (v. , vg , v^ ) , Amm (w n, #>^oai^«@«^^RAM2 8d(Dffl«««tcxhT 
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(XT-^y^/s) o mmz. mf^-^y^AA. 45 

coMSfiA . A f)Vtyyy Q l^X). RAM2 8dJ: 

m2ommm^y^i-^. i&n'ty^AA. a 

5, *iiSir>'9-4 6-4 9(CilP^T, #*«i(7)*«rigS 10 

-fe>^t4 0-4 3^ffiV^T^*te(?:>B^>^M>J(r07sU -y:/ 

Ut = r T a)T<J: D^^^*fi(DiifT::>^fnJ<30MiiiilS 

: . Sl , Sl , Sl Jl**feJlff;^fRjc?)M5i^«i: 

LT*$l3i^J;D**^UT . Ut . Ut . Ut t 

mn(Dmmyi . vt . vt . vt \z^r^^^:k:&. 

[»:3 5] Sl = 1 - (Ut /Vt ) 

Sl =1- (Ut /Vt ) 
Sl =1- (Ut /Vt ) 
Sl =1- (Ut /Vt ) 

*I^C7)^£jfiS*VT . Vt . Vt .V 
T fJ> 3 3 S;Tf#^nrcffi (Vt , Vt 
Vt ) , (Vt , Vt , Vt ) . (Vt , V 
T , Vt ) . (Vt , Vt , Vt ) COxyJ^ 

tl^c 30 

[Sc3 6]Vi =Vt cosA+Vt sinA 

Vt =Vt cosA+Vt sinA 

Vt =Vt cosA+Vt SinA 

Vt =Vt cosA+Vt sinA 

T> ^^m^\z^\^^xi!mmiy^i-^. msm^^u 

0 ^aj®$-a:fcfg^OM^«^AD^m^2 7 
(7) I/O 2 8 b^^LTA*$n;t!y:7r 6 l\Z-^7. 40 

ST^n-s (XT->y:/i) o 'A\z. mi^\z^n^ (x 

1 - 6 (?)«l3efi^ ^: Lfc^^CO*»ipftC0 
MJi^S (Vt , Vt , Vt ) , (Vt , V 
t , Vt ) . (Vt , Vt , Vt ) , (V 

T , Vt , Vt ) i7.^v^2-- 

3) o ^LT. mn^y^AA. 4 5 j:f5#^nfcBam 

ff:*[n]CD^aj^SVT . Vt , Vt , Vt 50 
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fl^ffM*^RAM2 8 dt::X hT-r^ (XT'^y7'4) o 
Mft^C, *$i5SSir>it4 0-4 3(Z)arJ&fficoT , CO 
t .cot .cot ^nyyy^r^K^M^iL^. RA 
M2 8 dctD^ft^grrO^T^-^^^n- HUT^»t3 
^0»«5SScOMii?ISM#fflUT , Ut . Ut . 
Ut ^^85^c -^LT> MiijSSVT , Vt , 

Vt . Vt ^nmu-Y\^x'^B^\zm^<mM:fu 

:i7^^A^||ff^'&T^*»C7)XU V^'^Sl . Sl > 
Sl > Sl ^^56^ ?tSi^*^R AM 2 8 d (CX 

bT«»<Diit-f ^7;P;0t)^T'r^ (x^-/:/4) o 
\^x^M(Dnm^\zm^tmmi>rzmm. :^fR]^}i^-r 
fii<i:t)igi o*^e» 1 4ic^u&T;]/=fuXAtciJEoTS 

^P^g^O-XYZT0Ma5^S (Vo . Vo , Vo ) 

:ot^5e)e>n^« :in^xm^xntz.i5ikhmm\z^^ i7 

uny\^=L-^\zX^mM(r>\^-(^)V(nm^^i^ t ,h 

■rnt^. mmm& (vo . vo . vo ) ^^mwc&nm 
T=()^r^)kAo:)n<^mM^rn\mmi.tz.^m (l 

0 . Lo . Lo ) ti^%^n^o 

[S3 7] Lo =FLo +Vo A t 
Lo =FLr, +Vo A t 
Lo -FLo +Vo A t 

fiL. (FLo , FLo . FLo ) UimM^^-i ^ )Vm(Dl»Wl 

mm<D^xh D T= 0 x(Dmmmt o tc^s^^nxv^ 
^fc. (Vo , Vo , Vo ) n^u(r)mkmm,(r^m 

[^3 7] ^m^m^mM^^^uz^r^m.'^^mi^^^ 

^^}sb^z,hffix^^. «_h. ifmmmmu}Hm\zr:> 

^^xm^m^^^xmmi^xmc. if^mu-mm^mm^m 

mL^^-^tc^m^±mz'mm'^tm.%(Dx^^o 
i>^*m\zn\.x^>u < h %^W5mz 2 m^-om e m 

(Str^Ki. ^-^m. ±T»i) . tt^tcoj^^tt^Dco^Jp 
jS^. ^mm (a-u>^. t!-/^>>/. a—o^) 

a-iz>^t. :*r^-iz>^t. mn^y^. -)j\±^y^m^m 
m'r^^t\z^x) ^momm d ^^^x u y E^m 
mwi\z'^^^x9MUAf)^')r)v^'iK\zm^^'^^o 
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[0 2] *^?3c7:)*6^MfflJgKco«^^^rEITfe^o 
[Ufa] *M-btc»«f ^ii[J»«'fe>1tor)WT^7hoo 

[0 6] ^ffi^n^jsifijssisii^ihjss^cigii-^jft 
[07] -fe^^tcT^^gfitRri^^^ h;Va)^«Ta&^p 

[0 8] ^t-i-^-^^mTt^^^^-s^^ftT^^o 

[Bf9] *W^fj«^>'X^A(7>A-F^7xT«^£Tab 



[010] V'f^n3>t::x :^[Ccfc^jlt!l«^(DiS» 

[01 1] ^-f^an>\^:j.-^\z^:^mmm^(DmW 

[012] ^-fi^uzL>}izL-^[z^:bmmm&(Dm,n 

[013] 'T^^pn>b"zL-^tc±^3S»ft^©aff 

[014] ^^^a:ny}:i3.-^\z^^mmm^(Dmw 

[015] *W$!l»5/X5"ACO^#:«^j£O«t--S;0 
[01 6] *MS!lfflI>'XT-A(^^#:«^CD«t.^0 
[017] ^air>i^-&#f>fjb:^c:«^Oji»f6S>-X^ 
[01 8] »SS.C,^'^;0>^co*«|fii:BcotfSflST&^o 

[019] MmmL-^-ms^Mmomm^nm^-jj^^ 

20 [020] #*«iC7)X U :/^Jfl^:5^iT^'^o 

[02 1] w^^m^h(r^^n<oi»w0i^. wm<om^ 

mmm^y^i-^G. i i-i v-f^nn>ifii.- 
^2s. 3St[i«^aisei 0 0. *:$^as-fe>it4 0-4 

3. mn^y^44. 4 5. *igir>1?*4 6-4 9. 

f^A'fe>-y-5 0. 



[01] 



[03] 



^ 72 




,1 ^ ) 



El 3 
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m 9 
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RAM28d 









2B^ 



( 1 -6 5 



[HI 0] 
@ io 

f START ) 



fROM?-*! 
C R0M2Sc> 













= 0 



< X9- j^2 > 

I 



cai7) siT 



( A ai. A Aaa ) 
( «& 1 2 ) I^H 











hi hi i.1 t-i 


A » 


n- K 



hi ha Zt ^3 



< A BU A«2» A a3> 
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[011] 
E 11 



CCPUXW] 



T 



a- ft 



<»25) 



,1 



n-H 



(Afeif Aa2' A ,3) 



(S26) mn 



rj 



(Ac X 



Ag7 *Aq^)| 



^ t 



1 



[01 2] 



g] 12 

ccpuxm cramt^-^] crom7-#] 





0 






7b1 3 ^ 







p- 


< 9 . f ) 



T 



-1^ 



mi 3] 

H 13 



CG PU«»] 



T 



P 5* 



< *-0) 



















C Ao X • Aoy » Ao B ) 
CVox* Vd7 . Vcs > 
CA«oi .A«M -Aflioa) 
( ft) i * 03 « *.oaJ 



( Aqx » Acy » Ac a) 

( Att-elj A«a2, A«fi^ 
I "al- "hS* Wbs) 



[014] 
IS 14 





















Ft y "Foji 



-J— 







.No,) 









1 xx'l y]r » I »B 

mutt 

I yC f I X7 ' 1 JEZ 

lU 



<Fox>Foy9 Fos ) 








Noy.Nofc) 






,Foy .Foi) 
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[015] [016] 
^15 IS 16 
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m 19 

CCPU 3 









J r 




hfr\ 




d t 











Be 


















C RAM ] 55. hT" 
C«Bj.».2* bS)| 


t . « 






f1 □- K 







VTf r=<Vrxfr ■) 



ROW] P« 



VTfi. Vrfr 
Vrri. VTrr 



C R AM D ^ 



■T f r\ 




[02 0] 
lil 20 



llliSJE 



m > 

Vtm » Vi ( n Vr rtF Vr rr 



► WTrr 



Wt , 



C RAM3 



IT 



Si.f^ > S bit 




C R AMI >t KT" 



[1^2 1] 
@ 21 




r RAM ] -J'JT- 



- 0 



0 - 


X Y Z H 




■fev h 





<ISIB 


) 



















t RAMD XhT 



(VD3,yi>,Voz> 



(IK 57) «?T 

< Lo X » Lot » U» ■> 



■ T + 



CRAM3 S8r 



( Ldx' l-Oy, Log] 
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